bool need_to_adjust
float64 target_yaw